EFFICIENT DIGITAL METHOD OF AND SYSTEM FOR DETERMINING 
THE INSTANTANEOUS PHASE AND AMPLITUDE OF A VIBRATORY 
ACCELEROMETER AND OTHER SENSORS 



Field of the Invention 

[01] The present invention relates generally to a method of and system for 
determining the instantaneous phase and amplitude of a sinusoid and more particularly 
to a method of and system for obtaining the instantaneous phase and amplitude of the 
sinusoidal output from a vibratory accelerometer and other sensors having a sinusoidal 
output. 

Background of the Invention 

[02] Many sensors produce a nominally sinusoidal output signal where the sinusoid 
amplitude or phase, or both, must be instantaneously determined in order to precisely 
estimate the input variable. For example, in the case of a vibratory accelerometer, there 
is generally a pair of tuning forks consisting of vibrating beams. With an acceleration 
along the beam axis, one tuning-fork structure is in tension, increasing its frequency, 
while the other tuning-fork structure is in compression, reducing its frequency. The 
output signal associated with each tuning-fork can be considered a general modulated 
sinusoid having the form: 

x(t)=a(t)cos(o) 0 t + 6(t) )=a(t)cos<p(t) Eq. (1) 

where 

a(t) is the instantaneous amplitude; and 
(p (/) is the generalized instantaneous phase. 
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[03] The generalized instantaneous phase <p(t) includes frequency information, as 
shown in the equation for the instantaneous (radian) frequency: 



Eq. (2) 



[04] In other words, co 0 is the time-average frequency, and the frequency modulation 
is given by the time derivative of 6(t). 

[05] In the example of the accelerometer, amplitude modulation may result from 
uncompensated power flow out of the respective oscillator, which can result from 
environmental effects or acceleration. Frequency modulation may result from a 
variation in the oscillator beam stiffness resulting from inertial acceleration. In order to 
control and compensate for the amplitude modulation, the amplitude of the sinusoid 
output signal must be measured. Once measured, the environmental and acceleration 
effects on the output of the accelerometer can be corrected. Furthermore, because the 
frequency output is related to the acceleration, the phase of the output signal must be 
measured in order to determine velocity. It is important to measure amplitude and 
frequency modulation at a high sample rate because the amplitude and frequency of the 
sinusoid may include large and rapid variations in the presence of large and rapid 
accelerations. 

[06] There are several conventional methods for measuring amplitude, including 
methods that require a tracking reference oscillator. However, the conventional 
methods suffer from excessive rectification of noise and spurious signals, errors in 
tracking phase, large environmental sensitivities and high ripple level. Likewise, prior 
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art methods for measuring phase, including counting sinusoidal zero crossings suffer 
from large quantization error, in that the phase measurement over any finite time 
interval is in error by up to 1/2 cycle with respect to true phase. This quantization error 
will manifest itself as noise on the measured phase, and errors in the inferred velocity in 
the case of an accelerometer. The phase quantization error can be reduced by 
interpolating within a sinusoid cycle by using a phase-lock loop and with analog 
integration. The phase-lock loop technique suffers because it introduces linear 
distortion in the phase modulation, which are errors that vary depending on the 
frequency of the phase variations. Analog integration techniques are subject to various 
errors associated with analog components. 

Summary of the Invention 

[07] The present invention includes a method of and system for measuring the 
instantaneous amplitude and phase of a sinusoid output of a vibratory accelerometer and 
other sensors. The system first digitizes the sinusoid and then passes the digitized 
sinusoid through a band pass filter in order to attenuate out of band noise such as 
harmonics in the sinusoid and remove DC. The digitized sinusoid is then delayed to 
produce the in-phase signal associated with the sinusoid. A phase shift is introduced to 
the sinusoid in order to produce the quadrature signal associated with the sinusoid. The 
in-phase and quadrature signals are then processed to determine the instantaneous 
amplitude and phase of the sinusoid. Note that the delay introduced in the in-phase 
signal compensates for the fixed time delay in the quadrature signal. 
[08] According to a first aspect of the invention, a method of determining the 
instantaneous amplitude (a) and phase (cp) of a sinusoid includes: 
[09] A. digitizing the sinusoid to form a first signal which is the in-phase component 
(I) of the sinusoid; 
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[10] B. introducing a phase shift into the digitized sinusoid to produce the quadrature 
component (Q) of the sinusoid; 

[11] C. processing the in-phase and quadrature components to compute the 
instantaneous phase (cp) of the sinusoid; and 

[12] D. processing the in-phase and quadrature components to compute the 
instantaneous amplitude (a) of the sinusoid. 

[13] The method may further include filtering the sinusoid before step B. Step B 
may further include introducing a predetermined delay into the quadrature component 
(Q). The method may further include introducing the predetermined delay into the in- 
phase component (I) before step C. Step C may further include processing the in-phase 
and quadrature signals according to the equation cp = tan'^Q/I). Step D may include 
processing the in-phase and quadrature signals according to the following equation 

a =^{Q 2 + J 2 ) - The filtering step may include attenuating out-of-band noise in the 

sinusoid. The sinusoid may be an output of a vibratory sensor, such as an 
accelerometer. 

[14] According to another aspect of the invention, a system for determining the 
instantaneous phase and amplitude of an analog sinusoid includes (i) a sensor which 
produces the analog sinusoid output in response to the measurement of a parameter, (ii) 
an analog- to-digital converter which receives the analog sinusoid from the sensor and 
converts the analog sinusoid' to a digital sinusoid which represents the in-phase 
component (I) of the sinusoid, (iii) a phase shift device which receives the digital 
sinusoid and produces the quadrature component (Q) of the digital sinusoid by 
introducing a phase shift to the digital sinusoid, (iv) an amplitude computation device 
which receives the in-phase (I) and quadrature (Q) components and computes the 
instantaneous amplitude (a) of the digital sinusoid and (v) a phase computation device 
which receives the in-phase (I) and quadrature (Q) components and computes the 
instantaneous phase (<p) of the digital sinusoid. 
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[15] The system may further include a filter device which receives the digital 
sinusoid from the analog-to-digital converter and removes out-of-band noise in the 
digital sinusoid before passing the digital sinusoid to the phase shift device. The phase 
shift device may produce the quadrature signal (Q) by introducing a -90 degree phase 
shift into the digital sinusoid. The phase shift device may further introduce a 
predetermined delay into the quadrature component (Q). The system may further 
include a delay device which introduces the predetermined delay into the in-phase 
component (I). The phase shift device may include a Hilbert transformer approximation 
device. The amplitude computation device may compute the instantaneous amplitude 
(a) of the digital sinusoid by processing the in-phase (I) and quadrature (Q) signals 

according to the equation a =^(Q 2 +I 2 )- The phase computation device may compute 
the instantaneous phase ((p) of the digital sinusoid by processing the in-phase (I) and 
quadrature (Q) signals according to the equation q> = tan'^Q/I). The amplitude 
computation device may compute the instantaneous amplitude (a) of the digital sinusoid 
by processing the in-phase (I) and quadrature (Q) signals according to the CORDIC 
algorithm. The phase computation device may compute the instantaneous phase ((p) of 
the digital sinusoid by processing the in-phase (I) and quadrature (Q) signals according 
to the CORDIC algorithm. The sensor may include one of an accelerometer, a 
gyroscope, a microphone, a vibration sensor and a chemical sensor. 
[16] According to another aspect of the invention, a system for determining the 
instantaneous amplitude (a) and phase (9) of an analog sinusoid includes (i) a sensor 
which produces the analog sinusoid output in response to the measurement of a 
parameter (ii) an analog-to-digital converter which receives the analog sinusoid from 
the sensor and converts the analog sinusoid to a digital sinusoid to form the in-phase 
component (I) of the sinusoid, (iii) a Hilbert transformer approximation device which 
receives the digital sinusoid and produces the quadrature component (Q) of the digital 
sinusoid by introducing a phase shift to the digital sinusoid, (iv) an amplitude 



BST99 1204265-2.056247.0155 



5 



computation device which receives the in-phase (i) and quadrature (Q) components and 
computes the instantaneous amplitude (a) of the digital sinusoid by processing the in- 
phase (I) and quadrature (Q) components according to the equation a =yJ(Q 2 +^ 2 ); and 
(v) a phase computation device which receives the in-phase (I) and quadrature (Q) 
components and computes the instantaneous phase (q>) of the digital sinusoid by 
processing the in-phase (I) and quadrature (Q) components according to the equation 
(p^tan^Q/I). 

[17] The Hilbert transformer approximation device may further introduce a 
predetermined delay into the quadrature component (Q) and the system may include a 
delay device which introduces the predetermined delay into the in-phase component (I). 
[18] According to another aspect of the invention, a system for determining the 
instantaneous amplitude and phase of an analog sinusoid includes (i) a sensor which 
produces the analog sinusoid output in response to the measurement of a parameter, (ii) 
an analog-to-digital converter which receives the analog sinusoid from the sensor and 
converts the analog sinusoid to a digital sinusoid sinusoid to form the in-phase 
component (I) of the sinusoid, (iii) a Hilbert transformer approximation device which 
receives the digital sinusoid and produces the quadrature component (Q) of the digital 
sinusoid by introducing a phase shift to the digital sinusoid, (iv) an amplitude 
computation device which receives the in-phase (I) and quadrature (Q) components and 
computes the instantaneous amplitude (a) of the digital sinusoid by processing the in- 
phase (I) and quadrature (Q) components according to the CORDIC algorithm and (v) a 
phase computation device which receives the in-phase (I) and quadrature (Q) 
components and computes the instantaneous phase (9) of the digital sinusoid by 
processing the in-phase (I) and quadrature (Q) components according to the CORDIC 
algorithm. 

[ 1 9] According to another aspect of the invention, a method of determining the 
amplitude (a) and phase (cp) of a sinusoid includes: 
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[20] A. measuring a parameter with a sensor; 

[21] B. generating an analog sinusoid representative of the parameter; 

[22] C. digitizing the analog sinusoid to produce a digital sinusoid; 

[23] D. filtering the digital sinusoid to attenuate out-of-band noise in the digital 

sinusoid; 

[24] E. producing an in-phase signal (I) associated with the digital sinusoid; 
[25] F. introducing a phase shift into the digital sinusoid to produce a quadrature 
signal (Q) associated with the digital sinusoid; 

[26] G. processing the in-phase (I) and quadrature (Q) signals to compute the 
amplitude (a) of the digital sinusoid by applying the equation a =yj(Q 2 +/ 2 ) ; and 

[27] H. processing the in-phase (I) and quadrature (Q) signals to compute the phase 
(9) of the digital sinusoid by applying the equation 9 = tan _1 (Q/I). 
[28] Step F may include introducing a predetermined delay into the digital sinusoid. 
The method may include introducing the predetermined delay into the in-phase signal 
(I) prior to step G. 

[29] According to another aspect of the invention, a method of determining the 

amplitude (a) and phase (<p) of a sinusoid includes: 

[30] A. measuring a parameter of an object with a sensor; 

[31] B. generating an analog sinusoid representative of the parameter; 

[32] C. digitizing the analog sinusoid to produce a digital sinusoid; 

[33] D. filtering the digital sinusoid to attenuate out-of-band noise and other 

spurious artifacts in the digital sinusoid; 

[34] E. introducing a delay into the digital sinusoid to produce an in-phase signal (I) 
associated with the digital sinusoid; 

[35] F. performing a Hilbert transform approximation of the digital sinusoid to 
introduce a phase shift plus delay into the digital sinusoid, thereby producing a 
quadrature signal (Q) associated with.the digital sinusoid; 
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[36] G. processing the in-phase (I) and quadrature (Q) signals to compute the 
amplitude (a) of the digital sinusoid by applying the equation a =yj{Q 2 +/ 2 ) ; and 

[37] H. processing the in-phase (I) and quadrature (Q) signals to compute the phase 

(cp) of the digital sinusoid by applying the equation cp = tan' ! (Q/I). 

[38] According to yet another aspect of the invention, a method of determining the 

amplitude (a) and phase (q>) of a sinusoid includes: 

[39] A. measuring a parameter of an object with a sensor; 

[40] B. generating an analog sinusoid representative of the parameter; 

[41] C. digitizing the analog sinusoid to produce a digital sinusoid; 

[42] D. filtering the digital sinusoid to attenuate out-of-band noise in the digital 

sinusoid; 

[43] E. producing an in-phase signal (I) associated with the digital sinusoid; 

[44] F. introducing a phase shift into the digital sinusoid, thereby producing a 

quadrature signal (Q) associated with the digital sinusoid; 

[45] G. processing the in-phase (I) and quadrature (Q) signals to compute the 

amplitude (a) of the digital sinusoid according to the CORDIC algorithm; and 

[46] H. processing the in-phase (I) and quadrature (Q) signals to compute the phase 

(cp) of the digital sinusoid according to the CORDIC algorithm. 
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Brief Description Of The Drawings 

[47] The foregoing and other objects of this invention, the various features thereof, as 
well as the invention itself may be more fully understood from the following description 
when read together with the accompanying drawings in which: 

[48] Fig. 1 is a schematic block diagram of the system for determining the 
instantaneous amplitude and phase of a sinusoid in accordance with the present 
invention; 

[49] Fig. 2 is a flow diagram of the method of determining the instantaneous 
amplitude and phase of a sinusoid in accordance with the present invention; and 

[50] Fig. 3 is a graph of a rotating digital vector in accordance with the present 
invention. 

Detailed Description 

[51] The present invention will now be described in detail with reference to Figs. 1 
and 2. As shown in Fig. 1, the system 10 includes an analog-to-digital converter 12, a 
filter 14, a delay device 18, a transformer 24 and a processor 19 including a phase 
processor 20, and an amplitude processor 26. Fig. 2 is a flow diagram of the method 30 
performed by the system 10 to determine the instantaneous amplitude and phase of the 
input sinusoid. While, as described below, the preferred embodiment uses a well- 
known Hilbert transformation approximation technique to convert sampled values, other 
techniques known to those skilled in the art for introducing a phase shift to a sinusoid 
may be used as well. 
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[52] As set forth above, the output of a sensor (not shown) is a sinusoid x(t) = 
a(t)coscp(t). This analog signal is input to A/D converter 12 and preferably sampled at 
ten times the sinusoid frequency, step 32, resulting in a sampling rate of 10 samples per 
cycle. The digitized sinusoid x[n] is input to filter 14, step 34, which is preferably a 
digital band-pass filter, which is used to attenuate out-of-band noise such as harmonics 
and other spurious signals, particularly those close to the sinusoid frequency. Filter 14 
may be a finite impulse-response type of filter. 

[53] The filtered, digitized signal x[n] is passed to transformer 24 where a phase shift 
is introduced, step 38. Transformer 24 is a digital filter that emulates the operation of 
an ideal Hilbert transformer over a specific frequency band, which has the following 
transfer function: 



# 0*>H n Eq.(3) 

[-j, co>0 

[54] Since, in practice, the ideal Hilbert transformer, as defined in Eq. 3, cannot be 
realized, the transformer 24 of the present invention produces an approximation of the 
ideal transform shown in Eq. 3. As a result of the approximation, transformer 24 
introduces a -90 degree phase shift as well as a delay to the sinusoid x[n]. Therefore, 
the output of the Hilbert transformer, y[n-k], is the quadrature signal (Q) associated 
with the input sinusoid x(t). Accordingly, if the input of the Hilbert transformer x[n] = 
a[n]coscp[n], then the output y[m] = a[m]sincp[m], where m = n-k and k = Tq/T, which 
is an integer equal to the ratio of the signal delay to the sample period. 

[55] The filtered, digitized sinusoid x[n] is also passed to delay device 18 where it is 
delayed, step 36, resulting in the signal x[n-k], which is the in-phase signal (I) 
associated with the input sinusoid x[n]. The amount of the delay introduced by the 
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delay device 1 8 is the same as the delay which results from the approximation produced 
in transformer 24. Accordingly, there is no timing delay between the in-phase I and 
quadrature Q signals. 

[56] Therefore, after being processed by the delay device 18 and the transformer 24, 
the original input sinusoid x(t) = a(t)coscp(t) has been transformed to the in-phase signal 
I = x[m] = a[m]cos(p[m] and the quadrature signal Q = y[m] = a[m]sin(p[m], 
respectively. 

[57] The in-phase (I) and quadrature (Q) digital signals define a rotating digital 
vector, such as that shown in Fig. 3. As shown in Fig. 3, the magnitude X of the vector 
is equal to the amplitude of the digital sinusoid x[n] and the angle a of the vector is 
equal to the generalized phase of the digital sinusoid x[n]. This digital vector can be 
expressed by the equation: 

c[m] = xlm]^jy[m] = a[m^ Mm] Eq. (4) 



[58] Once the in-phase (I) and quadrature (Q) signals are produced, the amplitude 
a[m] and phase (p[m] of the sinusoid x[m] can then be determined according to the 
following equations: 



a[m]= V^W + ZW E <l-( 5 ) 



<p[m] = tan [ x [m]j E< 1- ( 6 ) 
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[59] Referring back to Figs. 1 and 2, phase processor 20 performs the operation in 
Eq. 6 on the in-phase (I) and quadrature (Q) signals to obtain the instantaneous phase q>, 
step 40, and amplitude processor 26 performs the operation in Eq. 5 on the in-phase (I) 
and quadrature (Q) signals to obtain the instantaneous amplitude a, step 42. While there 
is a delay phase associated with the computations of the amplitude and phase, this delay 
phase is inconsequential in terms of velocity estimation, as it represents a constant time 
delay and does not affect the information content. In the case of the accelerometer, the 
delay needs accounting for only in terms of its effect on the response characteristics of 
an amplitude servo if one is used to control the amplitude, i.e., for servo stability. 
[60] Processor 19, including phase processor 20 and amplitude processor 26 
preferably includes a Coordinate Rotation Digital Computer (CORDIC) for fast digital 
trigonometric computations as described in the article "The Cordic Trigonometric 
Computing Technique", published in "IRE Transactions on Electronic Computers", 
September 1959 by J. E. Voider. The computations are effected via simple signal 
processing operations such as binary shifts, additions, subtractions and calling prestored 
constants. The CORDIC thus has a very simple and compact integrable circuit structure 
which in an integrated form requires a comparatively low gate count.. However, while, 
in the preferred embodiment, the CORDIC conversion process is used in separating 
phase attributes of complex samples from magnitude attributes, those skilled in the art 
can adapt other techniques, such as table look-ups and the like, in particular 
applications. 

[61] Accordingly, the present invention provides a method of and system for 
determining the instantaneous amplitude and phase of the sinusoidal output from a 
vibratory accelerometer or other sensor. The system first digitizes the sinusoid and then 
passes the digitized sinusoid through a filter in order to attenuate out-of-band noise such 
as harmonics and other spurious artifacts in the signal. The digitized sinusoid is then 
delayed to produce the in-phase signal associated with the sinusoid. A transformer is 
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used to introduce a phase shift and an identical delay to the sinusoid in order to produce 
the quadrature signal associated with the sinusoid. The in-phase and quadrature signals 
are then processed, preferably using the CORDIC algorithm, to determine the 
instantaneous amplitude and phase of the sinusoid. The system is a software-based 
system, therefore minimizing the need for hardware, does not require a tracking 
reference oscillator, a phase-lock loop or analog interpolation, and thus produces more 
accurate measurements than the prior art due to the decrease in the sensitivity of the 
system to noise and otheir environmental factors. 

[62] The invention may be embodied in other specific forms without departing from 
the spirit or essential characteristics thereof. For example, while the invention has been 
described in connection with a vibratory accelerometer, it will be understood that the 
invention may be used to determine the instantaneous amplitude and phase of the output 
of any sensor which generates a nearly sinusoidal output. Such sensors include, but are 
not limited to, gyroscopes, microphones, hydrophones, vibration sensors and MEMS 
chemical sensors. The present embodiments are therefore to be considered in respects 
as illustrative and not restrictive, the scope of the invention being indicated by the 
appended claims rather than by the foregoing description, and all changes which come 
within the meaning and range of the equivalency of the claims are therefore intended to 
be embraced therein. 
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